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PROBLEM TO BE SOLVED: To improve the position and attitude accuracy to enable the 
high-speed operation by correcting a deflection in a multi-joint robot. 
SOLUTION: Torsion (deflection) Aa, A|3, AG are obtained on the basis of the torque Tx-Tz 
around a shaft of a coordinate system provided in each joint part and spring constants kx~kz 
(S3, S4). Torsional quantity is added to correction D-H parameters as, (3s, 60s in the case of 
the torsion 0 to obtain parameters, a, |3, 00 (S5). Rotation angle 0' (0st) is obtained by 
reversely converting from a target position x by using the parameters as, ps, 90s (S6). A 
position x' is obtained by normally converting from the rotation angle 0' by using the 
parameters a, (3, 00 to obtain a difference Ax between the target position (S8, S9). This 
difference Ax is corrected to obtain a new target position x (S11). Reverse conversion and 
normal conversion are repeated each other, and the rotation angle 0when the difference Ax 
becomes the predetermined value or less is set as 0 after the correction, and a command 
rotation angle j. of which deflection is corrected, is obtained. 
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